#include "HT66F002.h"
#include "Sys_init.h"


void MotoControl(void)
{ 
    static  u8 j;     
	if(Flag_close)		 											
	{
		j=0;
	}
	else
	{
	 if(Flag_Moto)		 											
	   {
		j++;
		if(j==5)
		j=1;
	   }
	 else
	   {
		j--;
		if(j==0)
		j=4;
	   }
	}
	switch(j)
	{   case 0:
	        MotoA=0; MotoB=0; MotoC=0; MotoD=0;break;
		case 1:
	        MotoA=1; MotoB=1; MotoC=0; MotoD=0;break;	        
	    case 2:
	        MotoA=0; MotoB=1; MotoC=1; MotoD=0;break;
	    case 3:
	        MotoA=0; MotoB=0; MotoC=1; MotoD=1;break;       
	    case 4:
	        MotoA=1; MotoB=0; MotoC=0; MotoD=1;break;
	}    
}